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ABSTRACT 


This thesis propeses and develops two microprocessor 
Gontrolled ultrasonic systems which provide absolute 
coordinate reference for an autonomous sentry robot anja 
robotic manipulator. These systems close the position 
control loop which has never been fuil closed in rokotics 
and provide a better "testbed" for testing path planning and 
manipulator arm trajectory control. 

Each system involves known points of reference and 
ranges to these points which are determined by timing the 
interval of propagation of the ultrasonic transmissions. 
With this data, a microprocessor caiculates the positions in 
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I. INTRODUCTION 

As the automation of labor continues, mobile robots 
which can accurately navigate within their environments will 
become more important. Although these robots may not 
realize the humanoid forms of the science fiction writer, 
their design wiil entail several general characteristics. 
Foremost, a robot has a central controller which is most 
commonly a microprocessor or a network of microprocessors. 
Second, the robot performs a task or multiple tasks which 
are usually too frefetitive or dangerous for their human 
counterparts. Finally, the controller of the robot 
generally controls scme type ci mechanical motion. Paws 
motion includes mechanical Manipulators and Pplatecr m 
translation. Admittedly, these characteristics encompass 


Many systems which may or may nct be considered robots, but 


as of this date, there is no accepted definition for a 
ipo DO t.. 
The motivation LOG this thesis came fron wa 


Microprocessor Contrclled Autoncmous Sentry Robot", a thesis 
by Hobart k. Everett, Lieutenant Commander, United States 
Navy. In his thesis, LCDR Everett describes his first 
design for an autonomous sentry robot. LCDR Everett also 
states the need for absolute pcsition information by which 
the robot may effectively navigate [Ref. 1]. 

Currently, automated mobile platforms obtain position 
information from accelerometers, open-loop dead reckoning 
(DR) schemes, or remote control guidance. Each of these 
methods is unacceptable to the sentry robot concept. First, 
accelerometers are too expensive. The sentry robot is 
ideally an expendable resource since it may operate ina 


hostile environment. it 1s also a relatively slow device 


with small accelerations which reguire extremely sensitive 
accelerometers. The two preceding factors force Pre 
requisite accelerometer designs to be cost prohibitive. 
Secondly, by definition, an autcnomous sentry robot operates 
without human intervention. This reguirement eliminates the 
humerous remotely controlled systems. Finally, the inherent 
errors of dead reckcning navigation prohibit its use asa 
long-term navigation system. 

Even with the tmcst accurate DR and motion detection 
devices, position errors accrue in the position information 
due to measurement errors. Wheel slippage, turn radius 
errors, quantization and axle/potentiometer interfaces 
reduce the effectiveness of DR ravigation. Quantization and 
sensitivity limit the accelerometer guidance. Accidents or 
power interruptions, which involve the robot, adversely 
affect both DR and accelerometer navigation. 

The solution reguires the designer to fully close the 
Nhavigation/position control locp. The robot reguires a 
means by which it can independently update its position 
information. This informaticn comes from an external 
absolute reference systen. TO be effective, the reference 


svstem must eliminate or reduce the errors previously 


discussed and be inexpensive. In addition, the design 
requires low power ccnsumption, Small component size, and 
ease of implementation. Finally, if the update process 
operates quickly enough, the need for DR navigation is 


virtually eiiminated. 

Armed with accurate position data, the sentry's 
reconnaissance need not be random patterns like those 
generated by Everett's "Robart I". An effective sentry 
transits the entire threat area ina timely and efficient 
Manner. While random motion statistically ensures one 
hundred percent coveraye, there iS no guarantee of coverage. 


A robot, with a memory map as described by Bradley Weinstein 


in [Ref. 2], can guarantee one hundred percent coverage by 
recording its past visit times in areas and using these 


times to establish interim navigation goals. 


While the reference system described within this thesis 
is for a sentry robot, many of these navigation concepts 
apply to other robctic platfcrnms. One example is an 
automated platform for battlefield use. The United States 
Army has interests in this area. A second vehicle is an 
autonomous underwater venicie. Obviously, an underwater 
vehicle is of great interest to the United States Navy. 

The control of robot manipulators is closely related to 
the autcnomous sentry robot's centrol problem. Although the 
movements of the manipulator are constrained with respect to 
those or the sentry, the placement and accuracy of the 
reference system is far more critical with the manipulators. 
However, the manipulator controller, at present, still faces 
the same problem of closing the open-loop of the positioning 
system. 

The repeatability of current manipulators is .05 inches 
but the absolute accuracy is orly .5 inches [fef. 3]. Any 


improvement in accuracy requires better machining but ata 


Significant increase in cost. Manipulators have gear and 
wheel slippage, friction, and quantization problems just 
like those of the sentry robot. As a result, tne designers 


must include tolerances for errors or a human operator must 
reinitialize the Manipulator after a set number of 
movements. In order to nore fully automate these processes 
and improve their accuracy, the position control loop needs 


to be closed with a reference system. 


This thesis explores the hardware and software to 
develop a reference system for koth the sentry robot and the 
robot manipulator. The thesis treats the sentry robot 


problem first and the manipulatcr problem follows. All of 


the research involves ultrasonic sensors. The designs use 
ultrasonic sensors because of their cost and availability to 
the student, and considering that the medium is air, 
ultrasonic devices are aa logical choice. The theory of 


both systems resides in the next chapter. Chapters three 


through eight contain the hardware, software, and test 
results, respectively, for the autonomous sentry robot 
reference system. Following the sentry robot design, 


chapters six through eight present the manipulator design in 
the Same manner. Finally, chapters nine and ten summarize 
the conclusions and recommendations. The appendices contain 
complete copies of the software which were developed plus 
additional information which is referenced in later 


chapters. 
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IT. THEORY AND DESIGN 

The general design for both the sentry robot and the 
Manipulator positioning systems uses geometry which has been 
used in nautical navigation fcr many years. Given only 
Tange information from known points of reference, the 
mariner plots circles of equal distance centered at the 
reference points. The intersection of the lines define the 
Mariner's position. Numerous books abound which discuss 
this navigation method. This thesis will not discuss these 
concepts further except to note that three range arcs are 
required to ensure an unambiguous position or fix ina flane 
unless other information is available. 

The sentry robot's reference system involves two or more 
remote ultrasonic transmitters at known locations. Wnen a 
position up-date is required, the robot remotely keys the 
ultrasonic transmitters via a radio frequency link and neas- 
ures the time of propagation cf the sound waves from the 
remote site to the robot's ultrasonic receiver. Knowing the 
speed of sound in air, the robct determines the distance to 


the remote site using eguation 2.1. 


distance = velocity * (total time - delays) (egn 2.71) 


The delays will be discussed jater. Figure 2.1 shows a 
typical room with the appropriate geometry plotted. 

A rokot cannot implement this procedure graphically but 
must do so mathematically via a microprocessor. Appendix A 
contains a detailed derivation cf the equations. The equa- 
tions which descrike the coordinates of the intersections 


between two range arcs reduce tc a quadratic of the forn 
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A*x**2 +B*x + C = 0 {eqn 2.2) 


where 
A = 4* (OF 1**2+0F2* *2—-2* OF 1*OF 2+DIF ** 2) (eqn 2.3) 
B = 4* (OF2**3 - OF 1**3 + (OF 1-OF2) *R1**2 (eqn 2.4) 


+ OF 1*¥OF2**2 + (OF 2*OF1¥**2 + (R2**2) * (¥OF1-OF2) 
- (DIF**2)*(OF1+0F2)) 


C = R1*¥*4 + R2**G + DIF**Q4 + CFI¥¥4 + OF 2**Y (eqn 2.5) 
2* (- (R1*#2) * (OF 1**2) + (R1*#2)* (OP2**2) + (R2**2) *OF1#*2 

— (R1**2) *(R2**2) - (R1**2)* (LIF**2) - (R2**2) *DIF**2) 

- (CF1**2)*OF2**2) + (DIF**2) #0F1**2) 

+ (DIF#*2) *({OF2**2) - (R2**2) *(OF2**2) 


R1 = range to site cne (eqn 2.6) 
R2 = range to site two (can 2 i) 
OF 1 = cffset from reference origin to site (eqn 2.8) 


one on the axis of the coordinate being sought 


OF2 = offset from reference origin to site (eqn 2.9) 


two on the axis of the coordinate being sought 


DIF = difference in the offsets of the two (egn 2. 10) 


Sites on the axis of the coordinate not being sought 


By solving eguation 2.2 for ail known solutions, the 
robot determines its poSition by comparing the solutions of 
the various pairs of range-arcs, compariny the solutions 
with its estimated current position, or by using various 


BeEStLICtions: For example, this design permits operation 


Ws 


only in the positive quadrant of an K-Yogrid  coondiia: 
systen. Therefore, the program discards ali negative solu- 
tions. The design also uses feet as the fundamental unit 
although any dimensional unit will work as long as all of 
the guantities are uniform. 

Figure 2.2 contains a blcck diagram of the system. 
Whenever the robot reguires an update of its position, the 
robot's master microprocessor or a slave microprocessor 
which may he dedicated to navigation keys the appropriate 
ultrasonic transmitter by correctly emitting the ccrre- 
sponding radio transmission. This reguires the micropro- 
cessor to interface with the external radio transmitter. 
Simultaneously, the microprocessor initiates a timer which 
measures the time of propagation of the sound wave. At the 
remote site, a radio frequency receiver which is interfaced 


with the ultrasonic transmitter detects the appropriate 


radio signal. The radio receiver triggers the uitrasonic 
transmitter. An ultrasonic receiver which is also inter- 
faced with the navigation microprocessor detects’ the 


ultrasonic Signal at the robot. 

All of the necessary hardware components are readily 
available, small, and inexpensive. Most importantly, the 
components which are located cn the robot are low [ower 
consumers and they can be powered down when not in use. Low 
power consumption is essential to a truly autonomous robot 
Since its power supply is self-contained. 

While the sentry robot's position system iS primarily a 
two-dimensional problem, the manipulator control problem is 
three-dimensional. Again, the solution uses range informa- 
tion, gecmetry, and ultrasonic sensors to identify the fosi- 
time. However, the system doeS not reguire ae radio 
frequency link. Instead, the controlling microprocessor 
interfaces directly with the transmitting and receiving 


ultrasonic sensors. Tne problem reduces to an interface of 
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Figure 2.2 Sentry Reference System Block Diagram 


the ultrasonic components and a software package for 
Sonerol. Figure 2.3 shows a typical systen. Figure 2.4 
contains the block diagram of such a systen. 

The microprocessor determines the manipulator's tip 
position by applying the law of cosines to the range infor- 
mation obtained from the sensors. By placing three sensors 
in the same plane in an "L" formation, the problem simpli- 
fies and takes advantage of special geometry. Ip alej bons) ape. 
Shows the geometry of the systeu. The range information of 
any twe sensors, which are colocated on a reference axis, 
plus their respective locations, define the coordinate of 
the manipulator on the axis. Tte two range vectors form two 


cones which share a common base when the vectors are rotated 
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Figure 2.4 Manipulator Reference System Block Diagram 


about the common axis. The intersection of the cones! base 
plane and the reference axis defines the actual coordinate 


position of the manifulator. 

First, with the given range information and the law of 
cosines, the microprocessor computes the angle of departure 
or the range-vector with respect to the common axis using 


equation 2.11 


Alpha = arcos{ (AR*¥*2+BR**2-AB#*2) /(2*AR*BR)) (eqn 2.11) 


angle of departure (eqn 2. 12) 


Alpha 


AB = distance between the sensors Ceci a2. 15) 
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Figure 2.5 Manipulator Reference System Geometry 
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AR range from site A to manipulator tip (eqn 2. 14) 


BR range from site B to manipulator tip (eqn 2.15) 
Next, the microprocessor determines the dot product of tne 


range-vector and the respective axis using equation 2.16. 


Dot product = AR*cos (Alpha) (egn 2.16) 


The microprocessor cetermines tae actual coordinate by 
adding the dot product with the resnective site offset frou 
the system origin. 

After determining the seccnd coordinate in the above 
Manner, the system compoutes the last coordinate by applying 
equation 2.17 which relates a vector's magnitude with its 


respective projections onto a three dimensional coordinate 


systen. 
Ze= {AR**2 ~ X¥*Z ~ YR*2) **¥_5 (eqn 2.17) 
X,Y,2 = the respective dot prcducts of the (egn 2. 18) 


range vector on the axes 


This gecmetry permits the sensors, which establish the coor- 
dinate systen, to lie in a plane outside of the area of 
movement of the manipulator. Also, these eguations handle 
ail angles from zero to one-hundred eiyhty degrees since the 
cosine function is sSingle-valued over this region. 

Neither the sentry robot nor the manipulator designs 
focus upon a particular robot design. Instead, the author 
attempted to keep the designs Simple and transportable so 
the designs could be interfaced with many different systems. 


Farly simulations used PL/I on the Navai postgraduate 


ie 


school’s IBN 3033 systen. The actual test design involved 
Peace, Z-~-80 assemrly language, the Pro-Log STD 7900 
Development Station and externai circuitry. Programming 
occurred on an Alitos computer with MP/M II which contains a 
PL/I-80 compiler, Macro-80 compiler, Link-80 for module 
linkage, and Genhex for hex-code generation. As stated 
earlier, the above choices do nct reflect a design decision, 
but instead, reflect the availability of resources. 
Finally, the proyrams maximize their yenerality by having 
the hardware interface routines and the clock routines in 
separate modules. These routines which are specific to each 
implementation may be changed without seriousiy affecting 
the main computational progran. 

The remainder of this thesis presents the details of 
these test designs. The hardware and software of the sentry 
robot's reference system is first. The details of the 


manipulator reference system follow. 


20 


III. HARDWARE FOR THE SENTRY BOBOT*S POSITIONING SYSTEM 
From the beginning of this design, the utilization of 
Noff-the-shelf" compcnents waS a primary goal. By using 


components which are currently available, the design is less 


costly and the designer spends less time "re-inventing the 
wheel", Instead, the designer faces numerous interface 
problems between the various components. However, these 


interface problems, as a rule, are not as complex or 
difficult as designing the entire system from Scratch. This 
concept farailels current erforts in VLSI, custom chip and 
VHSIC designs where proven general designs are slightly 
altered for each specific use. Each new design is merely a 
collection of building blocks which have been previously 
designed, tested, and implemented. 

The microprocessor interface requires five logic coatrol 
lines outbound and one data line inbound. While these lines 
could be directly linked to the external circuitry via the 
data bus of the microprocessor, this is not a safe idea 
during early develorpment stages when many changes and/or 
accidents may occur. Appendix B contains an eight bit I/0 
port circuit designed by David Rigmaiden of the Naval 
Postgraduate School. This circuit provides protection for 
the microprocessor and an addressable input/output fort. 
The design uses two 74138, one 74273, one 7432 and one 74244 
Chips. The circuit includes access to the address bus, data 
bus, and the respective control lines such as read and write 
enable. 

The radio transmitter and receiver sections are 
available at Radio Shack (Cataiogue No. AAS INO Ae The 
remote control module pair, which is nade by Archer, operate 


Pei eiizeand =proyrae four control funmetions. Pulse code 
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modulation delineates two of taeé four control signals. The 
other two control signals are a constant carrier signal and 
the absence of a signal. The transmitter requires a nine 
volt DC power supply. The receiver requires Doth a three 
and nine volt DC power supply. [Ref. 4] 

The schematic of the transmitter is in Figure 3.1 The 
interface problems between the transmitter and the 
microprocessor are two-fold. First, the microprocessor must 
control three nine vclt power supply lines. Second, the 
microprocessor muSt ccntrol three low impedance connections. 
Normally, two double-pole/doutle-throw switches provide the 
requisite control. 

For the power Switching, the design uses reed relays 
from Claire and Archer. These devices are TTL compatible. 
Figure 3.2 shows the respective wiring diagrams. Eau tay, 
designs considered the use of NEN, CMOS, and VMOS devices, 
however the nine volt switching consideration always forced 
the contrcl voltage levels beyond TTL compatibility. Thus, 
typical microprocessor control was not possible with these 
devices. 

The interface circuit for the low impedance lines uses 
the National Semiconductor CD4066BM/CD4066BC quad bilateral 
Switch as shown in Figure 3.3. This analog switch is ITL 
compatible as long as the IC's fower-supply, Vdd, remains at 
iTL levels. Tf£ the chip's power supply exceeds five volts 
(maximum allowable voltage is fifteen volts), the control 
voltages, which turn the switches off and on, must also 
increase beyond TTL levels. This fact makes these switches 
unuSsakle for the power switching control of this system. 

Arned with the circuitry of Figures 3.2 and 3-37 50bae 
microprocessor keys the radio transmitter by sending the 
appropriate code to the I/O port at address "FF", Tabilces 
contains the respective codes and their consequences. When 


ail connections are open, nc transmissions exist. A 
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Figure 3.2 Power Switching with Reed Relays 
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Figure 3.3 Low Impedance Switching with an Analog Switch 


Z5 


combination of transmitter connections between transmitter 
terminals two and three with either terminal four or five 
powered by the nine volt source creates the respective pulse 
code modulation from the transmitter. The connection of 
transmitter terminals one and three generates the constant 


ZT? MHZ =earri cr; 


TABLE I 
Transmitter Control Codes 


00. « «2s « & «= s ALP NeOnnceeronsmerene 


O01. +s «© « « « « « CONStANt Cabri er Geen oman 


10... « « « « »« 500 hertz pulse code modudatien 


+e —2- ww. = © 


0 0 
0 0 
0711C . « « « « « «= « 3000 hertz pulse code "nedutacees 
1 0 
(The most significant bit is the left bit.) 


The receiver schematic diagram is in Figure 3.4 The 
three receivers each detect the complete Set Ob @icontumes 
Signals. The receivers have three power sections which are 
hormally used to power DC Servo motors. The transistors 
which control these fewer secticns are marked in Figure 3.4 
When the appropriate signal is present or absent, the 
collectors of the ccntrolling transistors have associated 
voltage ievels. An LM311 comparator tests these levels and 
appropriately keys the ultrasonic transmitter. Figure dao 
shows the comparator and the interface circuitry which keys 
the ultrasonic transmitter. 

During this research, the author considered two 
different ultrasonic devices, the Polaroid Ultrasonic 
Ranging System and _ the National Semi-Conductor 1M1812 


Ultrasonic Transceiver Driver with the Panasonic EFR-OTE4OKZ 


Ceramic Transducer. The Polaroid device is an excellent 
system for range finding during obstacle avoidance. The 
half-power bandwidth is narrow at ten degrees. It also has 
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Figure 3.5 LM311l Comparator and Interface Circuitry 
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an autcmatic sensitivity control which enables the device to 
provide reliable data out to thirty-five feet [Ref. 5]. 
Although this device was usec at the remote sites for the 
system test, the LM1812 is a better choice at both the 
remote sites and at the robot as a receiver. The Polaroid 
device uses an electrostatic transducer wnich must be 
polarized to receive correctly. The device must either 
transmit or have a 150 volt power supply in parallel with 
the transducer to correctly pclarize the device jRef. €]. 
In a receive only mode, a transmission to estaplish this 150 
volt differential is unacceptable and the circuitry which is 
required to maintain a constant 150 volt level is too costly 
in power consumption. The Panasonic transducers are ceramic 
devices which are permanently pclarized. Thus, the dévice 
is passive in a receive onlv mnede. 


Alsc, this positioning concept reguires omni-directional 


transmission and reception. Ccmparing the 3-db beam width 
Girne Polaroid and Panasonic devices, the Panasonic 
transducers need far fewer transducers operating PE 


parallel. The Panascnic 3-db beam width is sixty deyrees 
[Ref. 7]. Therefore, the receiver needs only six Panasonic 
devices versus thirty-six of the Polaroid design. Each 
transmitter site needs only three Panasonic transducers to 
provide one-hundred and eighty degrees of coverage (if the 
transmitter is placed against a wall). 

Padre 226 CONtains Ehe Circuit diagram for the LN1812. 
The diagram contains a complete design which will both 
transmit and receive. The connections marked with an 
asterisk need not be made when the device is acting only as 
a recéiver. 

Figure 3.7 contains the circuit diagram for the Polarcid 
systen. Texas Instruments now markets an improved version 
of the Pclaroid Ranging Module, which is called the SN28827. 
The SN28827 uses two Texas Instrument chips, the TL852Z and 
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Figure, 3.6 LM1812 Schematic 
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Mmeal. HOwever, thiS unit 1s Cccmpatible only with Polaroids 
electro-static transducer and thus the lack of permanent 
polarization remains. 

Beiia lb y, three separate devices provide voltage 
regulation for the circuitry. Ali nine-volt sources use the 
fees 1 7 . The six-voit sources use the LM340T-6.0 and the 
three-vcit sources use LM723CN. The different current 
reguirements of the three voltage supplies deternined the 
device which was employed. Figure 3.8 contains’ the 
regulators and their external circuitry. 

As stated earlier, the micrcprocessor interface contains 
five outbound lines and one input. The outbound lines 
merely act as switches to turn the respective transmitters 
on and off along with the requisite power supply. The lone 
input line tells the microprocessor whether an ultrasonic 
signal is present at the receiver or rot. Therefore, the 
entire power On) Gliaing, GaJeculation, and distance 
determination lies within the scftware portion of the system 


which is discussed in the next chapter. 
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Figure 3.7 Polaroid Ranging Module Schematic 
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Figure 3.8 LM317, LM340T-6.0, and LM723CN Voltage Regulators 
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The structure of the software package is modular so that 
the pertability of the package is increased. The package 
has two requirements which are uniyue to each microprocessor 
or robot design. First, the system needs a timing function 
which may be realized ina hardware or software clock. 
Second, the input/output port control iS unigue to each 
microprocessor design. Both o£ these variable segments 
reside in assembly language modules. As long ag the 
appropriate control signals reach the external circuitry and 
the correct propagation times return to the main progran, 
the major portion of the program needs no change. 

Appendix C contains a listing of all of the programs. 
Figure 4.1 contains a flow diagram of the basic logic of the 
progran. The main program initiates the majority cf the 
system variables including those which are passed between 
the PL/I language programs and the assembly language 
programs. Following the above initialization, the PL/I 
program calls an assembiy language program which is cailed 
THERES te initialize the Pro-Log 7804 Z80A Processor 
Counter/Timer Card which is resident in the STD 7000 work 
station. This hardware clock frovides the reguisite timing 
function. For this system, the clock acts as a down counter 
which counts .0002 second intervals. Whenever an interval 
expires, the counter/timer card generates an interrupt. The 
assembly language subroutine CLCCKSR services the interrupt 
by incrementing and storing the clock count. CLOCKSR also 
Checks for a time-out conditicn and sets the approrfriate 
error flag. The time-out and error flag will be discussed in 


more detail later. 
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Figure 4.1 Flow Diagram of Sentry Reference System Lecgic 
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After initializing the clock, the PL/I srogram Seria, 
keys the remote transmitter sites via the assembly language 
POG EF daliewetegie This is the only parameter passing which 
occurs between two different types of language routines in 
this systen. KEY starts the clock and passes the code to 
the output port which contrcils the radio tLlansnitecers 
Subseguently, KEY goes into a loop which polls the input 
port and the time-out flag for a change of status. Once a 
change in status is detected, KEY stores the data and 
returns control to the PL/I procgran. 

Between each measurement cycle, the transducers need 
debouncing to prevent erroneous signal detection. The WAIT 
subroutine provides this feature. WAIT tests the input port 
for the presence of a signal and upon finding no signal, it 
begins a decrementing counting loop which gives the 
transducer “ringing" sufficient time to. aie outs When the 
count reaches zero, WAIT returns control to the PL/I 
program. 

Once the propagation times are returned to the PL/I 
progran, the PL/I Subroutine CONTIM converts the time of 
propagation into distance using ecliataon 2. 1 The 


remainder of the PL/I program impiements the solution cf the 


range-arc intersection problem which was described 
previously. Finally, the program passes the desired 
information to the CRT. In an actuai robot, other programs 
Or microprocessors would use this information for 
Navigation. 

Four features cf this system require additional 
discussion. Piast. if the ultrasonic receiver fails to 


detect a signal, the system weuld stall indefinitely while 
it awaits a signal detection unless a provision is nade to 
cover this possibility. The time-out flags handle this 
Situation. In the clock service routine, the prcgranm 


compares the current value of the clock count with the value 
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which equates to the largest dimension of the room. If the 
clock count exceeds this value, the error flag is set. A 
propagation time larger than the maximum dimension of the 
grid places the robot outside tne grid coordinates. 
Obviously, this can not happen. 

The second feature involves the reactions to various 
combinations of data. If all three remote sites are 
detected (all time-out flags unset), the program solves the 
intersection for two pairs of frange-arcs and compares these 
solutions to find the correct position. As stated 
previously, the worst case solution for any pair cf 
range-arcs is two sclutions with all positive coordinates. 
This causes an ambiguity. The second pair merely resolves 
the ambiguity. 

When only two range-arcs are detected, the progran 
computes their intersection and resolves any ambiguities by 
comparing the positions with the best estimate of the 
current position. The robot accepts the solution closest to 
its estimate of position. This is a reasonable assumption 
Since the basic concept identifies a need for the robct to 
update its best estimate of position with this systen. 

The third feature consists of the cases where cnly one 
or no ultrasonic signals are detected. In the former case, 
the program prints an error message and the available data. 
In the latter case, the prcgram prints only an error 
message. In an actual inplementation, the navigation 
package should continue to guide the ropot by dead-reckcning 
(DR) while the remote sites are polled again. This is true 
in both cases. 

The final feature also conceras erroneous data. PL/T 
provides error routines which assist the microprocessor in 
recovering from calculation errcrs such as taking tne square 
root of a negative number. When this occurs, the data is 


bad frem one or more remote sites but no time-out flags are 
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set. In this program, the system returns to the CP/M 
operating systen. In an actual implementation the systen 
should repeat the polling process in the same manner as when 
there is one or no receptions of the ultrasonic signal. 
Again, the dead-reckoning duties continue. 

In summation, each of these features attempts to counter 
a set of less than optimum conditions. In the event these 
conditicns occur, the robot continues to DR itself which is 
the current conventicn or at worst, the robot can halt its 
Motion until a good set of data is obtained. Loopiag 
through the remote keying segment of the program provides 
successive attempts to relocate the robot and eliminate the 
problem. With this being the case, recognizing an error 
becomes the major worry and not so much what the error is. 

Finally, the passing of parameters petween the PL/I and 
the assembly language modules needs further discussion. fhe 
discussion of this subject in [Ref. 8] is not adequate. 
Basically, whenever a PL/I routine calls an assenbly 
lanyuage subroutine or functicn and passes the module a 
parameter, the PL/I program dleaves an address in tne HL 
register pair. The program fcllows the normal addressing 
scheme with L containing the lower byte of the address. 
This address points to the first entry in an array which 
contains the addresses of each of the parameters which are 
being passed. Again, the normal address convention prevails 
as the low order byte is stored first. This second address 
is the physical address whick is assigned to the variable 
for the duration of the program. Any program which accesses 
this variable must use this address. As a result, all 
assembly language programs which return data to a PI/I 
program simply place the data at the physical address and 
return control to the PL/I progran. The PL/I program has 
conventions for remembering the addresses of the variables. 


Figure 4.2 contains an example. [Ref. 8] 
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HL Beets ret upon entry into L OOH 
assembiy language progran Hi FAG) S| 
(pointer to address list) 

Data at address 2000H 2000H OOH 
(address of variable 1) ZOO ta 50H 
Variable 1 location (1 byte) 50008 x XH 
Variable 1 location {2 bytes) 5000H XXH 
(low order Lyte at 5 OOH} 5001H Orde 
The eke | eee a rogram pes jata at addresses 
5000H (1 by ¢} or 5000H and 5SO01H (2 bytes) to return 
data to the PL/I program. No other conventions are 


required. 


If a second variable is passed, HL plus two contains 
the address. 


HL after two increments i QO2H 
H 20H 

Data at address 2002 2002H FFO 
20038 50H 

Varible 2 location (1 byte) 50FFH Ox H 


Figure 4.2 PL/I - Assembly Language Parameter Passing 


One additional word of caution iS hecessary. The actual 
definition of the variable (eg., &-bit integer, 15-bit real 
number) determines how many bytes are required to represent 
a variable. For example, a fifteen bit real number recuires 
two bytes. Each byte is addressable. When a PL/I program 
passes such a variable, the prcgram passes only the address 
of the lowest order Lyte. hithin an assembly language 
program, each access of a twe-byte variable requires the 
Manipulation of two addresses. 

Discussions about the progran timing and systea 
feasibility follow in the next chapter with the results of 


the testing phase. 
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Although the implementation was not optimum, the systen 
works to within an accuracy of +/- one foot. Figure 5.1 
contains a diagram of the rocm in wnich the test were 
conducted. Table II and III contain eight sample points 
With three succeSSive attempts at each coordinate. The 
tables list the respective ranges to each site and the 
coordinate solutions. For example, position one in Table II 
contains four entries with five elements in each entry. The 
first row is the actual measurements and coordinates for 
position one. The remaining three entries are measurements 
and coordinates which were precduced by the systen. The 
first three columns list the distances from the various 
transmitter sites to the test fosition wnile tne remaining 
two columns compose the X-Y¥Y ccordinates. The worst case 
accuracy falls in fosition two with the X coordinate in 
error by 1.1 feet. The average positional error for all of 
the positions is 0.54 feet. Although an accuracy of one 
foot initially appears to be large, the system is actually 
more than adequate when one considers the entire sensor 
package which is located on a mobile robot. For botw 
intruder and fire detection, sensor ranges come in tens of 
feet. Therefore, the robot dces not need greater accuracy 
with which to report its findings. The robot's report 
contains more general data such as a room location or 
sector. On the other nand, the accuracy for production line 
work is far greater. During proximity Bavigation, a £Linare 
grid reference system fails Ty itself when faced with 
dynamic room designs. The remainder of this section 
presents the problems with cures which were faced during 


this irplementation. 
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TABLE if 


Sample Position Coordinates 


Position Cne 


Site. | SpeesZ Site 3 XK a4 

10 7 10 10 7* 

a7 lai OZ TOra3 fares 

103 7.4 9.7 10.3 7.4 

10.1 eace 10.6 10.1 Tat 
Position ‘Two 

10.8 11 10.8 10 1 1* 

9.2 hig 2 Vide oye, lidicnt 

8.9 105-7 10.6 cea 1026 

Sag 11.4 11.1 8.9 ile3 
Fosition Three 

14.6 Va 7 Tee 14 11* 

136 11.9 723 14.6 10.9 

1216 171.5 Gas 13.6 159 

1320) ne es: Phew 13.1 10278 
Position Fcur 

Sia) Gand VW6ize= 4 3* 

Bad 17.4 OE 
oe 655 16.6 Le oe 
oes, Spey 16.4 4.4 2 


* Jdeal measurements and coocdinates 


4 2 


Site 1 


TPZ 
6.8 
ed 
5 


10.1 
Ost 
10a 
10.3 


ive © 
ioioe 
18.7 
1657 


12.2 
1.9 
V2] 
126 


* [deal measurements ard coordinates 


Site 2 


a ee 
Ua: 
Vas. 7 
biees. 
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© ais. 
6.4 
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TABLE JIL 


Sample Position 


Coordinates (cont'd) 


Position Five 
Site 3 


14.6 
14 


14.2 


14.6 


Position Six 


ie) 
10.1 
10.6 
deleed 


Position Seven 


Se 
4.9 
Sao 
6.2 


Position Eight 


Ciaz 
815 [e 
8.1 
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Cencerning the radio transmitter/receiver pairs, the 
problems were three-fold. First, the power surges which 
occur as the radio transmitter is turned on and off affect 
the ultrasonic receivers. This results in false echo 
detection. The power supply to the radio transmitter 
requires separate voltage regulation (LM317) and filtering 
capacitors (0.1 uF) to eliminate this problem. 
Additionally, the radio transmitter board, if not completely 
powered down, generates erronecus Signals. Although these 
Signals are not of the three reguired waveforns, the 
receivers process the erroneous Signals and charge various 
Capacitors to unknown levels. This condition destroys the 
reproducibility of the data. Asa result, the system design 
incorporates the reed relays to control the power switching. 

Secondly, the receiver's initial stage 1s a Colpitts 
OSCil lator. The oscillator directly interfaces with the 
antenna andthe power supply with no buffering. As a 
result, receivers interfere with each other if they are much 
closer than ten feet or if they are not properly isolated 
from grcund loops. Since the radio dlink works at 
twenty-seven mega-hertz, a .01 uF capacitor in parallel with 
a 1 uF capacitor provides Sufficient ere crac. As Douglas 
V. Hall states in [{Ref. 9], 


NEvery capacitor, because cf its leads and internal 
CONSeLuctran has some series inductance. This Sel aee 
inductance Lo ether with the capacitance forms a 
series-resonant Circuit...above tne bPesonant errequcne, 
the net reactance is inductive _increasing. as_ the 
frequency goes Bie Because of the increasing inductive 
reactance above the resonant frequency , the capacitor 1s 
becoming iess and less effective at ‘shorting. out" or 
Filtering out high-frequency voltage tranSients...a 
combination of two capacitors thus provides filtering 
over a wide range cf frequencies." 


Thirdly, objects in proxinity of the antennas disturb 


the respective electromagnetic [propagation patterns. On an 


actual robot, this constraint forces the antenna on top of 


Quy 


the robot such that the antenna pattern is least affected by 
the robot body itself. Likewise, rooms with large numbers 
of metal objects or fpoorly shielded electrical cable alter 
these patterns. The large metal desks within the test roon 
(Figure 5.1) caused serious degradation of the system when 
the transmitter was within two and one-half feet. However, 
Since the radio and ultrasonic circuits were not fully 
shieided, the total fossible reduction of these effects is 
not available. 

Earlier discussicns treated some of the problems of the 
ultrasonic devices. in addition to the requirement for full 
room coverage, two additional problems arise from _ the 
ultrasonic circuit board. First, the Polaroid board 
contains a five milli-second delay between the time the 


transmit cycle is initiated andthe actual time of the 


ultrasonic transmission. This delay is also 
hon-reproducible [Ref. 5]. While this did not gressly 
affect the systen, future improvements in the _ systen 
accuracy regquire an improvement in this aspect. The 


National Semi-Conductor 1LM1812 has no documented delay. 
Again, the LM1812 appears better for this application. 
Secondly, the gain control of the ultrasonic receivers is a 
Major key to the success of the system. This implementation 
Hoes net Contain an automatic cain control. [ Ref. 10] has 
miciwea Cifcuit Lor* the LM1812- During testing, the lack of 
a gain control necessitated recalibration of the time delays 
whenever the robot platform mcved in excess of +/- three 
feet. With an automatic gain control, this calibration 
should not be necessary. 

Ena, | am@eOLager Copy or f[ Refs 70] (1977) contains a 
meise reduction tip@for the LW41812 chip which is not found 
in later versions. "Inductive kicks" cause erroneous 
ultrasonic detections. A capacitor of approximately 30 pF 
between pins three and four reduces the bandwidth of the 


receiver and filters cut these unwanted noise detections. 
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Initialiy, assumptions did not include allowances foe 
circuit delay or delays in the radio link. However, each 
link has a different delay. Since each link bases its 
actuation upon a different signal, one expects a different 
delay gor each link. As expected, the delays increase as 
the pulse code modulation rate decreases. The delays ies 
the 3000 hertz, 500 hertz and constant carrier are .0i1, 
PO rg ee and .098 seconds respectively. However, these 
parameters are unigue to each circuit! The progran 
implements these corrections via the constants, DEI1, JDEI2, 
anGieD Eis 

In conjunction with the frevious discussions on the 
circuit and radio link delays, the major time constraints 
come from the debouncing features of the progran. When 
three signals are detected, the system returns a solution in 
a total time of 1.5 seconds. The above time includes one 
debouncing call before keying each of the remote sites. fhe 
WATT program incorporates a comkination of no signal and an 
arbitrary time delay to debounce the receivers. With more 
accurate testing, the time for debouncing is reducible. Ort 
course, if one or more Signals are not detected, the total 
system time becomes a function cf the time-out conditions. 

Although each circuit nominally has small current 
requirements, the short term requirements force careful 
voltage regulation at both the robot and at the remote 
Sites. In addition to the pcwer switching of the radio 
transmitter, the remote ultrasonic units also cause the same 
problems. For the Polaroid dé€évices, the circuit reguires 
Six volts at two and cne-half amps for one milli-second. A 
combination of an LM340T-6.0 voltage regulator and a 470 uf 
capacitor at the load prevent the ultrasonic circuit from 
disturbing the power supply. Interruption of the power 
Supply disturbs both the radio receiver and the 


comparator/interface circuits. 
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Obviously, the number one problem of an ultrasonic 
system is obstructicns. For this reason, the actual 
implementation of this design on a robot reguires the radio 
antenna on top of the robot with the omni-directional 
ultrasonic receiver section directly underneath. The 
highest obstruction within the environment determines the 
Minimum height at which the ultrasonic system may be 
located. Since the program needs a Mininun of two 
unobstructed ranges for a_ solution, the line of sight 
between the robot and two of its remote siteS must remain 
clear. As long as the prograga knows the location of the 
Sites and the correct distance to the site, the coordinates 
are obtainable. Later chapters discuss alternatives for 


Site location and systems with more than three remote Sites. 
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VI. HARDWARE FOR THE HANTPULATOR REFERENCE SYSTEM 

The differences between the sentry robots reference 
system and the manifulator's are few. However, these few 
changes are significant. Overall, the design reguires fewer 
components and is, therefore, less complex. 

The manipulator's reference system does not have the 
need for total autoncny which the mobile robot does. AS a 
resuit, all of the peripheral sensors directly interface 
with the microprocessor. This eliminates the need for the 
radio links. Additionally, this eliminates all of the noise 
which is associated with radio transmissions. 

Second, the microprocesSSoOr input/output ports reverse 
their importance. In the sentry design, tne output port 
Maintains the proper control of the three remote transmitter 
sites. The manipulator uses only one output to key a single 
transmitter which is located on the arm. The design again 
uses the Poiaroid ultrasonic device as the transmitter. fhe 
interface circuitry consists of the normal TTL logic signal 
for the microprocessor and the comparator circuitry in 
Figure 6.1 which was used at the remote sites in the sentry 
design. 

The input ports change from an omni-directional receiver 
input to three single multiplexed receivers. No actua 
wiring changes occur. HoweveL, the software services the 
input port differently. The next chapter further explains 
the changes in the software. There iS one addition to the 
LNDUt el be Ua ti. The Polaroid devices do provide access to 
the actual transmitter driving signal. The signal nawfle is 
MXL@G'< This Signai allows the system to begin the systen 
clock synchronously and also improves both accuracy and 
reproducibility of the data. Table IV contains the 


Input/Output port Contigurarvon—. 
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The remaining circuitry remains the same as in the 
sentry design. This inciudes the microprocessor workstation 
and the LM1812 ultrasonic circuits. A three-quarter inch 
plywood board provides the requisite support for the three 
ultrasonic receivers. 

The software changes, which are discussed in the next 
chapter, likewise, are few. This circuitry provides a 
Simple but effective system with which a reference systen 
may be estabiished. However, as will be discussed later, a 
final design will require much wore detailed analysis of the 
transceiver design such that mcre uniform coverage may be 


obtained. 
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As stated previously, the sentry robot software is 
modular in the hope that it might be more portable. The 


manipulatcr software also follows this policy. In fact, the 


manipulator software originated from the sentry rokot 
software with only a few changes. Figure 7.1 contains a 
Elock diagram of the system logic. Appendix D contains the 


complete program listings. 

The program has the same major sections as the sentry 
robot's progran. After initialization, the Main progran 
serially determines the distance between the three receivers 
and the transmitter which is located at the manipulator tip. 
This procedure involves three calls to the assembly language 
modules as in the previous prcgrams. Next, the program 
checks fcr proper reception of data. ieetne data is bad, 
the program terminates with an error message. If the data 
is good, the program first calculates the iine-of-sight 
departure angle and then tke ccrresponding axis coordinate. 
Lastly, the program prints the appropriate data nto the 
ehT . 

Obviously, the calculaticns which are made in the 


Manipulator program are different from those of the sentry 


program. However, the dekouncing and time/distance 
conversicn modules are unchanged. The "ANGLE" and "CCORD" 
modules replace the "POSIT3" and POSIT2" «modules. By 


comparing the two PL/I programs, their similarity becomes 
apparent. 

Just as expected, the main changes in the programming 
occurred in the assembly language modules. While the 
parameter passing remained unchanged, both the clock and the 


receiver poiling are different. To obtain a more accurate 
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Figure 7.1 Flow Diagram of the Manipulator System Logic 


clock, the program implements a software clock. A software 
clock uses a specific loop with a known execution time to 
increment a count of the real time. In this case, the loop 
increments in .00005 second intervals. Within the loop, the 
program polis the input port fcr the appropriate reception 
of the ultrasonic’ signal. The transmitter code of the 


sentry robot program becomes a receiver code in this system. 


D2 


During the polling prccess, the microprocessor "AND's" tae 
code with the input from the pcrt. Table V contains these 
codes. The program tests for proper Signal reception by 
checking the various flags which are set by the “AND-ing" 
operation. Upon Signal reception or time-out, the progran 


Peturns control and data to the PL/I main progran. 


TABLE V 


Receiver Control Codes 
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(i ae er oe RCCCLVCr.3 reception 


ft es eae LLOG Signal reception 
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The most Significant bit is the left position.) 


Since both the receivers and transmitter are directly 
interfaced to the microprocesscr, reduced delays and nore 
positive ccntrol are fossible. Also, the XLOG Signal which 
drives the ultrasonic transmitter interfaces with the 
Microprocessor and initiates the software clock loop. 

analy, while this systen encompasses fewer 
alternatives (no degraded modes), the system still must 
recover gracefully whenever no solution is possible. If any 
of the time-out flags are set, the system prints an error 
message. Also, if the data does not provide a solution 
(eg., the program attempts to take tne square-root ofa 
negative number), the PL/I error routines print the error 
messages. In an actual implementation, the program should 
Simply loop for another attempt. Currently, the loop takes 
less than one second. These problems are further discussed 


in tne test results which follow. 
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VIII. MANIPULATOR COORDINATE SYSTEM 

With the elimination of the radio circuits, the accuracy 
and consistency of the distance measurements impreve 
tremendously. When the tratzsmitter is stationary and 


successive measurements are taken, the differences occur in 


the hundredths of a fcot. The overall positional accuracy 
of the system increases to the tenths of a foot. Table VI 
and VII contain a listing of sample position data. The 


tables list the respective rarges to each sensor and the 
coordinate solutions. For example, position one in Table VI 
contains four entries with six elements in each entry. The 
first row is the actual measurements and coordinates for 
position one. The remaining three entries are measurements 
and coordinates which were prcduced by the systen. The 
first three columns list the distances from the transmitter 
to the respective receivers while the remaining three 
columns compose the X-Y-Z cocrdinates. The worst case 
accuracy falls in position seven with the Y coordinate in 
error by 0.32 feet. The average positional error for all of 
the positions is 0.30 feet. 

Even with this improvement in accuracy, the accuracy is 
not good enough for truly intricate assembly maneuvers. 
This is due inpart to the lack cE an automatic jain control. 
Whenever a Significant change in the transmitter positicn or 
orientaticn occurs, the time response of the ultrasonic 
receiver changes as previously discussed in the test results 
on the sentry robot reference systen. Secondly, further 
research 1S necessary to fully calibrate such a_systen. 
This calibration includes the definition of a reference 
point on the transducer from which the distances are 


measured. Additicnally, the introduction of more 
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transducers for an increase in coverage adds to the 
calibration problems. 

This design, however, proves the feasibility of such a 
systen. By constraining the sensors to. one plane, the 
Manipulator enjoys a full range of unobstructed motion. The 
designer places the reference system wherever tke location 
is most convenient. This includes floors, ceilings, walis 
or in the face of the manipulatcr base. Thus, the reference 
system may be absolute when it is stationary or relative 
when it is rotated on the base. 

The system loop takes less than one second to complete. 
Again, the debouncing routine causes the longest delay. A 
reduction in this delay will cptimize the system response 
Since the WAIT routine is called three times. This design 
does not minimize this delay. Additionally, the delays for 
the three receivers are .023, .019, and .022 seconds for 
receivers one, two, and three respectiveiy. These delays 
are also much less than the sentry robot design because they 
do not include the radio link delay with its pulse code 
modulaticn. 

Most of the improvement in consistency of the data is 
attrikutable to the usage of the XLOG Signal from the 
[errasonic Circuit bcard. This signal eliminates the need 
to estimate the five milli-second delay between the 
activation of VSW, the keying sSijnal, and the actual 
transmission. Instead, the clcck begins its count when the 
actual transmission Signal originates. The LM1812 has no 
such comparable signal unless the transmission signal to the 
transducer head is used. 

The system concept is feasitle. With the gain centrol 
and turther calibraticn, the desired system accuracy should 


be obtainable. 
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measurements and cocrdinates 
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Sample Position Coordinates (Manipulator) 
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IX. CONCLUSIONS 

The position control loop in robotics no lonyer needs to 
be a semi-closed loop. With an ultrasonic reference svsten 
in piace, positive control of a mobile platform or 
manipulator is possible. Alsc, a reference system limits 
the cumulative error since it becomes a function of the 
coordinate system's recursive cycle. Armed with this 


information, a controller can implement more sophisticated 


guidance rackages without ccmplicated error-correcting 
software. 
The cost of such a system is not prohibitive. The cost 


orf the major components keep the total system hardware cost 
well below $250.00. Even with more dedicated designs, the 
System cost, when mass-produced to lower the cost further, 
makes the reference system an expendable commodity. Asa 
Matter of fact, a Single prirted circuit board desioqimire 
easily conceivable which would permit the maintenance 
operatcr to simply remove and replace the entire system. 
Since the device need not ke powered continuously, the 
system is alow power consumer. This is a mandatory 
requirement for an autonomous robot. Even tne Polaroid 
device with its two and one-half ampere current requirement, 
operates successfully on batteries. Polaroid uses’ the 
PFolapulse battery for power in its test and evaluation kits 
[Ref. 5]. Therefore, the power considerations are minimal. 
While the two systems failed to achieve the desired 
increase in faccurdacy, closer cooperation with the 
manufacturers and additional research surely can improve the 
system accuracy. The chapter on recommendations includes 
hints by which the accuracy of the svstems may be improved. 


Most importantly though, any implementation of these 
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ultrasonic devices dictates the use of an automatic gain 
Goentrol. Unfortunately, this research only identified this 
problem and the cure. Neither design contains this control. 

Of course, the number one enemy of an ultrasonic systen 
is obstructions. tf the signal can not reach the receiver 
via its line of sight, the system does not work. Therefore, 
within reason, the concept requires sufficient refereace 
transmitters/receivers to previde one-hundred percent 
coverage. As the number of transmitter/receiver sites 
increases, the complexity of the encoding schemes’ which 
control these sites increases. The sentry system reguires 
at least two ranges at all times while the manipulator 
reguires at least three. The environmental geometry 
dictates the actual number required. 

Although the use of PL/I was expected to hamper the 
system speed, this was clearly not the case. The main time 
delay of either system is the various debouncing routines, 
the Signal propagation, and the time delay of the external 
erecuitry. Accordingly, the use of a faster (greater than 
two mega-hertz) OL larger {greater than 8 kits) 
Microprocessor will not provide a corresponding payoff in 
throughput. Until the other delays are reduced, the 
emphasis of future designs should focus upon optimizing 


these circuits and ccmponents. 


As stated earlier, the Polaroid ultrasonic unit is an 
excellent device for ranging. The unit is easy to 
emncorporate into designs and is extremely reliable. 


However, in this design, it fails to provide sufficient 
receive-only capability and beam width. The Panasonic 
EFR-OTP4OK2 transducer when incorporated with the L41812 
provides far better results, even though the L41812 reauires 
fair MOre Circuitry. 

Finally, this thesis cannot over emphasize the necessity 


of following good "breadboard technigues". Although the 


a, 


following list may seem obvious, the number of hours spent 
trouble shooting problems associated with the list was 
large. 

1. Regulate all power Supplies. 

2. Use filteringicapacitcors —libetagety: Remember, it 
may require two in parailel to fully cover the 
requisite bandwidth. 

3. Use heatsinks on all reculators. 

4Y. Use only good breadboards or wire-wrap. 

5. Follow good solder technigues. 

6. Use coaxial cable wher possible, especiaily when 
the distance is over Six iaches. 

7. %Do not underestimate the power of proper shielding. 

8. Elan your layout camerully. 

9. Color code your wiring. 


10. Divide and ccnguer or segment and test. 


Uitrasonic reference systems are realizable and 
feasirle. ThiS «thesis lreileeis this, The future of 
robotics should no longer contain open loop designs. The 
reference systems can Le inexpensive, accurate aud low 


power. Closed loop ccntrol is fossible. 
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X. RECOMMENDATIONS 

Both the sentry and manipulator reference system designs 
provide a means by which the fosition controi loop can be 
closed. As stated in LCDR Fverett's thesis and numercus 
other texts and reference, sefarate Microprocessors should 
implemert these functions in paraliei with the master 
MLCLTOLIoceSsSOr. However, the designs need further research 
and development. 

Foremost in the sentry design is the need of a more 
consistent radio link. The problems which were attributed 
to the Ccipitts oscillator can be eliminated with a better 
design and a change in operating frequency. Or course, a 
final implementation requires greater attention to circuit 
and cabie shielding. Antenna placement is also important. 

Second, Piece grattONne Orme tne transduccr, into a 
functioning system while obtaining the necessary coveraye is 
important. Unless an omni-directional transducer 1s 
available, any design will freguire multiple transducers 


working in parallei ktoth at the transmitter and receiver 


locations. While this may be less of a problem in the 
sentry design, the manipulator, With its infinite 
orientations, is a most feeroeure oproblen. These 


applications might require an originai transducer design. 
Transducer sensitivity 1s controllable through external 
circuitry on the LM1812. Since tne Polaroid device provides 
excellent control of the sensitivity out to a range of 
thirty-five feet (seventy feet including the return path), 
the range or current devices is more than adeguate for the 
Manipulator and the sentry rotot for indoor uses. Any 
implementation which uses ultrasonics needs this sensitivity 


Gomerol , especially when the operating distances are in 
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close [roximmty. Without the automatic Gain Controle 
time delays are variable and dependent upon the distance or 
Signal strength which 1S unknown. Further, no device 
currentiv employs gain control oa the transmitter. ieee 
closed loop and close proximity system such as these, the 
transmitter gain control might use the estimated position as 
as reference by which the gain is varied. Tiis permits the 
usage of constant gain receivers in a multiple receiver 
systen. 

Although the velocity of sound is not” Crit icaaeie 


dependent upon temperature, it is none the less a function 


of temperature. The LM3911 easily provides temperature 
sensing which nay be directed Lo the navigation 
microprocessor. With the correct ambient temperature, the 


microprocessor updates the speed of sound with which the 
time/distance conversions are made. A change fron 
Sixty-eight to sixty-nine degrees Fahrenheit translates to 
an additional one foot per second in velocity. 

Although the basic calculations will not change, the 
error handiing within each software package is unigue to 
each aprlication. While looping successively through the 
program is an obvious choice to )comee@er « "fou the 
gesigner faces more important guestions. Shouid movement 


continue? How fast can actionS continue? Howiarge ereuerme 


tolerances? Tie designer's considerations include the 
machine and the envircninent. Finaliiy, cedunlarcv invezoves 
reliabiiity aud accuraw, ) pln it increases Cost amd 


complexity. 

Even though the accuracy of the ropot sentry and 
Manipulator designs does not improve upon the current 
accuracies of systems without Such references, the 
theoretical limits of accuracy which area function of 
frequency are far better than current systems provide. FOr 


examovle, at fifty kilio-hertz, the wavelength is .272 inches 
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or .69 centimeters. Ae) 200 kKilo-nemez, the wavelensth is 
Mier inches or .1/7/3 centimeters. Since tne Signal detection 
dépends upon the rising edje or the incoting signal, 
accuracies of this magnitude are possibile. Any delays are 
of no conseguence as long as tné deia;sS are consistent. 

With the final desicn perfected, tne aeSired positive 
control 1S possible. Martin Weinstein in [Ref. 2] gives a 
very detailed description of a memory map witn which 
Navigation planning and obstacle avoidance might be 
performed. However, two additional items should be 
considered. First, any navigation scheme needs an endroint 
Se egoai. Second, the memory map needs to incorporate visit 
time within its structure. The goal in ae sentry's 
reconnaissance is cne hundred percent coverage of the 
security area in a timely manner. Therefore, the interin 
goai becomes one of visiting the block with tne oldest visit 
time. Once the goal is determined, the navigation unit 
decides the optimum fath. As the robot transverses’ the 
chosen path, the navigation microprocessor updates the visit 
times of the blocks which are crossed plus ALL BLOCKS WHICH 
fem PNIO THE SECURITY OR FIRE DETECTION RANGE OF THE 
hesen'S SENSORS! This schene allows the sentry to previde 
one-hundred percent coverage since a block which is not 
visited will eventually become an interim goal as its visit 
time grows to exceed all others. Weighting factors which 
are associated with high risk areas improve the revisit 
times to these areas. 

LCDR Everett mentions path planning routines Such as the 
computer game "Othello", Also, in [{Ref. 11], four papers 
addressed this issue. They are listed in the bibliography. 
However, the work by Keirsey et al. at the University of 
Florida and at Hughes Research Laboratories looks very 
promising. In their paper Pret oe |e this group 


Substantiates their work in tactical navigation. More 
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specifically, their work includes search gm@aph Construct ten 
and heuristic searches for path planning. 

The Zenith Corporation currently markets an ET-18 Rokot 
Remote Control Unit which provides remote control for tne 
HERO Robot. The srenmcte control unit also interfaces with 
macroprocessors through the RS-232 loop. This system isa 
potential testbed for botn the reference system and varicus 
robot control aigorithms. Currentiy, robots, like the HERG: 
do not keep track of thelr fositions nor do they have 


sufficient memory onkoard to store the programs for such 


research. This experimental set-up provides both centrol 
and Vitrtuawy unlimited ne MOLY while the cost Gand 
complexity of the rokot is held to a Minimun. With this 


arrangement, the ultrasonic transmitter and receivers should 
exchange piaces for the best resuits and ease Om 
implementation. Consequently, the remote receivers 
interface to tne microprocessor via hard-wired connections. 
Also, the Microprocessor keys the ultrasonic transmitter on 
the robot through the radio remcte control. 

The literature on manipulator control is far more 
abundant. However, no model ccmpleteiy closes the position 
control loop. At best, the ccntrollers deal only with the 
motors and the motor feedback. The systems do not directly 
measure the errors whick were discussed previously. These 
systems rely upon error models cr no models at all. 

While the three dimensional system herein does locate 
the tip of the manipulator, the system fails to identify the 
orientation of the gripper cr tne rotating base. A 
Manipulator with six degrees cr freedom needs additional 
reference data to fully orient the systen. A possible 
solution consists of optical caiitbration dines which vcaneee 
accurately located and read on the manipulator. The optical 
sensors and cable are smail and light. They will not place 


any further weight restricticns upon the arn. Also, 
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today's optical comyonents interface directly onto printed 
Glrcuit boards and integrated circuits. These advantages 
Support this approach very strongly. 

The three dimensionai reference system provides jiata 
fom which position and velocity information May be 
determined. While this information is in cartesian 
coordinates, the conversion to other coordinate systems is 
availabie and weil dccumented. Microprocessors handle these 
conversions nicely. As a result, the myriad of nanipulator 


control schemes have a better testbed upon which they can be 


tested. More importantly, the manipulator will no lenger 
require the teaching cycles Which currently program 
industrial robots. Instead, the potential is present for 


the manipulator, when it iS given the various coordinates, 
to determine both the commands andthe routing for each 
task. Much of tcday's rorotic research deals with 
high-level hierarchical languages for robotic control. With 
these languages, more general commands such as "pick up 
block" release the frogrammer from the tedious task of 
providing the exact ccmmands for all of the motors involved 
mi the mction. 


In summary, with the positicn loop finallv closed in the 


mobOtics field, more positive control is obtainable. An 
ultrasonic system Will not handle every environment. 
However, With additional research, the environments for 


which uitrasonics are suitable will be identified. The goal 


of increased accuracy will become a reality. 


APPENDIX A 
DERIVATION OF SENTRY FOSITION EQUATIONS 


uiiees derivation is a general solution for an 
intersection of two range arcs which are associated with two 


different reference fecints. 
Coordinate definitions: 

x 
Mi 


XAOF +/- XA 
YAO? *t7geiaA 


XBOF +/- XB where __OF are the offsets of 


YBOF +/- YB the reference points from the 
CLrigingamcd Xm@jor Y ieee 
respective distances to the 
rosition from the reference 


points in vector notatiom 
Range arc definitions: 


RR=* 2) XA Rt A where _r is the radius of the 


BR**2 = *BY¥F2 + YRBerZ arc 
Egquate X's 
XAOF +/- XA = XBOF +/- KB 


Solve the range arc equations fcr the vector magnitude X_ 


and substitute into the above eguation 

XAOF +/- (AR**2 - YA*#2)**.5 = XBOF +t/~- (BR*¥*2 - YB**2) **.5 
Rearranging 

+/- (AR**2 - YA**2)**.5 = XBOF - XAOF +/- (BR*¥*2 - YB**2) **.5 
Define DIF = XBOF - XAOF and square both sides of the eguation 


AR**2 - YA**2 = DIF**2 +/- (2*DIF*(BR¥*¥2 -— YB*¥*2)**.5) + BR¥*2 
~YB**2 
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ree nOn ety (2 ~Dit*{BR*e*2 — VYE**2)**.5) and square both 


sides of the equation again 


ye (DIF**2*(BRE*¥2 - YB**2)) = AR*4 + YAR*4 + YBE*4 + BR#KY 
+ DIFE*4 + 2* (-AR**2*YAR*2 + ARPK2"YBEX2 - YB**2 *DIF**2 

— YA**2*YB**2 - AR**24BR**2 + YA**2*BR*¥*2 -— AR**2*DIF**2 

+ YA¥*2*DIF**2 - YB**2*BR**2 + ER**2*DIF** 2) 


Substituting for YA and YB, and expanding the terms yields 
the guadratic equaticn which was discussed in chapter 2 


(eqn 2.2) 
COEF 1*Y**2 + COEF2*Y + COEF3 = © 
where 


eee = te (YAOF**2 + YBOR**2 — z*¥YAOF*YBOF + DIF**2) 


meer 2s — O*(AR=S24YAOE — YAOF**3 — YBOF**3 -—- AR*¥* 2*YBOF 
+ YAOF*YBOF**2 + YAOF**Z*YBOF - BR¥*2*YAOF 
SO aT nO ern * 2*YEOR = DIF **2*"Y DOF ) 
COEF3 = AR*¥*4 + BR¥*¥4 + DIF**4 + YAOP**4 + YBOF*¥*4 


+ 2* (AR**2*¥YBCF**2 - AR**K2*KYAOF**2 -— YAO F**2*YBOF¥**2 
— AR*¥*2*BR**2 + BREX2*YAOP**2 -— AR*®*2*DIF**2 
DIF**2*YAOF¥*2 -— BR**2*YBOP**2 + DIF**2*YBOP**2 
BR¥* 2 *DIF* *2) 
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